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(57)Abstract 

PROBLEM TO BE SOLVED: To correct the measuring errors of an 
attitude sensor at a camera eye point and achieve MR with no 
dislocation by correcting accumulative errors in a sight direction 
caused with the lapse of time, in particular. 
SOLUTION: Firstly, a template image is drawn (S501). Then, an 
image It is photographed (S502). The output of a sensor is also 
acquired at this time (S503). A model view matrix Mt is calculated in 
accordance with the output of the sensor (S504). A correlation 
matrix AMt is calculated (S505). The model view matrix Mt is 
corrected by using the calculated correction matrix AMt (S506) and 
CG is plotted and displayed by using the corrected model view 
matrix (S507). 



r 



a 

m 
■J 



i HE'S ^ i- * t tf?f$ ; Q^Rrn 




CO 

yy 
m 



LEGAL STATUS 

[Date of request for examination] 06.03.2001 

[Date of sending the examiner's decision of rejection] 

[Kind of final disposal of application other than the 
examiner's decision of rejection or application converted 
registration] 

[Date of final disposal for application] 

[Patent number] 34866 1 3 

[Date of registration] 24.10.2003 

[Number of appeal against examiner's decision of 
rejection] 

[Date of requesting appeal against examiners decision of 
rejection] 

[Date of extinction of right] 



Copyright (C); 1998,2003 Japan Patent Office 



http://www1 9.ipdl.ncipi.go jp/PA1 /result/detail/main/wAAAfoaWFZDA41 4259992... 2005/1 0/07 



as)B*m¥fVff? (j p> 



(A) (U) 

4#BB2002 — 259992 

(P 2002-259992 A) 
(43)&PBB ¥fi£l4^ 9 H13Q (2002.9. 13) 



vol; Int. ll 


7 




T? T 7*1— k' ( 


bUol 


f/bU 


15U 


pact 7 /cn i cn R 9T?nfi^ 
VjUuI f/OU 10U D 6rU0u 


PA 1 D 

bUlB 


1 1/UU 




bUlD 1 1/UU n DdUOU 


uUol 


1 /f\f\ 

1/UU 


315 


VjUdI 1/UU olu OdUD f 




i *7 /a n 
1 7/4U 




1 (/ 4U c oLuy 0 










(21)mH# 




«NB2001 -62224 (P 2001 -62224) 


(71)ffiISA 397024225 








^t: l^oectr J-xa • y — /I/ • S ^ J-\w\y\*rT\ 


(22) nuns 




¥/£l3^3£ 6 0 (2001.3.6) 


*UC«BlflK«f«=TI2*Ht 








(72)fg^# fem mm 








^»rfTBIK7El^fflI6TB145Site 818**6 
























(74)tt3A 100076428 








#a± *i§? mm 








mmm\zm< 



(54) [«^o*fW H^3£«:feJ;tf*©#ttafctfK::/a4f5i>.3---K. EfflKft 



(57) [S*j] 

S-r^>yu-hH«!S:f^fi£T^ (S 5 
0 1). JfcKHIfcl ' ©flUBSfrS (S 5 0 2) . X. 
Z<D£2<D±>Viiitl<DW<%h'fT? (S 5 0 3) . #.\Z 

5 (S 5 0 4) . -?-bT«IEff?'JAM , (DWMZfto 
(S 5 0 5) . ^■LT^ffiLfcttlfT^JAM' Srffll^T 
^JHfi-ff^JM' £f|IEL (S 5 0 6) . UlEbfc 
^^Hfi-ffMSrffl^TCGSitH. S«t* (S 5 
0 7). 



| »>ri/-hB»afWt [] — 



S501 



T-S502 



^f/l/t-^-fryilM'oyiB | — SS04 



-TryitffiE } -SS06 
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1 

affilS^at, 

ffiEBBgB*t»«Lfc«BiiiB£*»::. flf£©fig?© 
-fv hKa»«#a&, 

BEffi-Mffi t j»ES«r*S fc <fc o TUf * tifcMEff ffl 
flWRfca^T. »Eff-«»*©»iMsJ:tf/*fctttt 20 

b * m tu-r * bu #a t * m x. a z. t z&m. 1 1 z> mm 
«rEW-*«ti»EE*¥a«»E*-r*ittEiicm«**ffl 

V>Tl»E»«lBi«k1'fc*W<5»*0 : fWtt«**«). M 
EttWBjfc5#W£n5fflEBBBB©n-;U2f[6i©|§| 

teftfc V» Efcisa * a K»^H^ * *3 w * a tt 
Bft£lsTttftr«C&£<MR&?«M:ft«lKeft«> 

adages. 30 

T, 

BEBWRtt. ttEffHMt£ttEfflEffttKS-3»T 
BEM-WttBroBBSBaj-r* H t «4*«£T<6ni#JH 
2 KEftOBBBaBB. 

[B£B 4 ] WEBtBBBttltfrE&B-fe >tfjWHBIT 
T, 

BEBm^Rtt. WEW-ffl!i«ttwEttiEttffitcso*^T 40 
BEtfB*tB©BB£»tti"r* ci t £B«&rsM£B 
i cE«©H«fflase. 

c»*«5] bebubbh:. WE»»-fe>-y-*«w-* 
-t * £&© tfasffl ©bm * »3Et s fc » ©*sie*38 <t . 

BEBW^SM:. BEthBB£BE»jEBffi.i:BE<4B 

«*icacJv>T»Etni»*©tt«i6»sjia-r* c t 

[»*JB6] BEBttiBBttBE»BBB©«BB;£ 
©ftgtitlST&oT. 50 
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BEBffl^ate. BEBWBfcBEttBBBfcB^T 

BEtt»*#B©fiBBB*Bfflr*;i£*wai:-*-*B 

*J|lXli2 tceftOBBfiBIIB. 
[»**7] BEH«#att. BEBHJ^SKfc^T 

i Ao*o»«««*iaan&**tc*jv»Tt). bebb 
SE«©*^5««*K:*»t**tf€r*iai?6ii!5< 2*iajo 
&b«b*hbts z. t * ttwiii-rzmxm 5 xa 6 c 

E«©BflB*2LagB. 
[»#JH8] BEBlEBBtt, BEBB-fc 

-r •sbbwbbb© -5 ft <Djj&jjfa<Dmm zmiEt a it 

t S»«fr*«*J!l 3 755 5 ©I^T 

n*» 1 «tE«<oH«fflage. 

[B#*9] BEBB^Stt. «MBj|«l««fCfitt 

*WE»*©«att«Ka^t»Ti»Ejitai««*»wr 
5 c: t swatr *bbb inm8<D ^rnfr 1 ace 

n*BE»fflB«©KWB©ft«BK:»-3v>TBE»lH 

wbsmb-t * - 1 sBatrsttsfcB 3 x»4xb 6 

(cEttOBBBaiSB. 

[B#B11] WESffStt. KIB^-y^H* 
«f tc*3 » * BEmBw^B&B t lMrEttantBom t' 
B-^TBEBtBBBSHB-r * - 1 an* 
« 3 £Bit®BftA9£B. 

[B#B12] BESB^Rtt. BEBH^ftCBt* 

n*i»E-ftio«Bttfca6^^»Ti»Eimi««*K(fr 

[ffl#JK13] MG3GK^K». BE»W#RK*^ 
[«*au] fflEmB». f»EflBHB±lcBB$ 

n&a*amt©7 > h v— ^ ©s^«!T** a c <t 
Bt-r-5»*js 1 75s 1 3 ©u»m*» 1 mtzKMawm 

CB**15] ME5>H'7— ^oiljlffin^ic^tt 
«ttBtt8E»T**Ci:€1*«fraB**l 4(rE« 

C»*JM16] WEItBtt. WEBBiOB±©llOB^ 
©T$>^dt2r^®<>:f *B*JB4Xttl 1XB12C 
EBOiSBfflaSB. 

1 7 ] WEfhB*f«tt«(rEaB^fi©aB« 

jST**^t«»«i-ra«*JH 17551 6©t»-rn* 

1 J«fcE*©BiB«iaSB. 

[W*^ 1 8 ] ffiEfttfi^atfff tU IsfcffiEBBSB 
Oi6B*fcttffiB»»l=aStJ«r»T. i!5B»f8!iii&K<£S 

SF^©^*sgjsabx^*-r-5«*^a : £:^^(c#-r 
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3 

s z. t £■? zm&m 1 i iz^m^mmmmmm. 

T. 

izmmtut-?-?. mtrnm^mmrnvrz^mmmmoi 

Hffiit^a*! 175116 mi-rtlfr 1 JlfcEiiCDH 

h wm&m ^ftT- v- v v v j- yv\z&. 1 xn r> m 
t. 

wtB^^-fe >*«»fni l tzmzgmoymmm. *mm vx 

£&»«»+ £fftTOreBOM2IMtt£MGtt- 

saB© o%v>u—)vjj\pt\<nmfcft \z&-3^tzmuwim* 
t^>^u- hv^5 : ->^5aa2:fT5cittr«fco. me 

C5 ^IQOBGA KS^&iatefflfflSa Lfclffl^! 

*£i 17SS 2 0«Dlr>f*l*>lW: 

£«©B&$!L3SB. 

[»*jg 2 2 ] mESa-n >v\t?j{iLj]fav>mwm\z 
wmmmzmvfz&mxmm&mm<Dn&m&.(Dgm 

1 a£Ett<Z>£B-fHMSB. 40 

oT#§J$£*-l££<t£#S££Tr£, B#3S2 2KE«<B 
KffrM-MlfcB. 

[»**2 4] tt»&*£<aM0ffiBHaatB££tt 
T^5»«t^Bfc±oTa[*Hife*is«i-r-5S«5xa 

i»E«-ji»*©*»*±r;/*fcttffiB*, mE«i»tt- 
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««*EB-r*EBl8i:. 

h.ts.^9-f v hM*W8t6^-y» MOBRJ6I 

at. 

ffi-rsaaxai. 

j»E*uiaT*ia bfci»E»«©*utefi»:as-^v» 
t. MEE«iaT?E*aFnfci9Eina«**H«f-r* 

Hfriat. 

WEW-MB fcWEK«fxaTH«r * ftfc*&B*Hi««fc 
H^»T. ME»iM»*©*iM3.fctf/S&ttteB£» 

m-ra*mxaa:*«A*ci**«fr*ii«uaa* 
[b*j«2 5] mn?-yv ha^ts^xatt, 

*9EW-«ffltWEEBX8TE1»bfe«(lESmifa*ffl 
EfhW«a»&*WSn*ttE««£B©n-;i^&G]©B 

^anacB©«ia«*K:jfiUfcBB*fffi!6b. h 
sat bra*-*-* 2 3 ICE® 

[ffit#a 2 6 ] 2 4XB2 5 CGtOlftfil 

[B#a2 7] »*J12 6KB*©^n^7A3-H 
eflMA-TSBflUK*. 

[0 0 0 1] 

fc»4ttB*»sm*-r*HBffl«SBRtf-t©*feafetf 

[0 0 0 2] 

[ft*©«fi5] ifi¥. «£a§H!& <KT. TMRJ (M 
ixed Reality) i»t) l:HT4Sf^« 

[0 0 0 3] MRKtt. Kx**^7«t^©JMJ«BT 
JIB3nfcaftgm0**lc£a£m <fc.t*J4*n>hr 

D (Head-Mounted Display) ta 

[0004] MRofomt 1,-04. m.mv>&to<D&=?*: 
mmvx^z>fr<D£?\zmffi\zm*-rz>mmm&)v>mm 

s-r*feaai»©aatt£, ^-stovr 
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[0005] z.n<z><Dfem\ziiiVT&m\zm3i2n2><D 

[0 0 0 6] t*x^-->— 7s)\>— ^jSGOMRfCfett-SftB 

& FpIS t ^ x * . 

[0 0 0 7] S£J1?<DMR->X^A (^KMrt K*5tt -5M 10 

x. m%±>v^m^&-t>vK£<D®.mgm-t>y-% 
Afflux. cn&o«^©tt«»»*9na-r*Jit*«- 

[0 0 0 8] — ^. Se*roM^fC*5tt-5MR->XT-AT 

3Wi*isi©Aa«*w-Mr*fc»&o«*©^r'f 
-tr>+>-T&-5a*, *BjifflT«fl!a:±cn$:^v-f 20 

[0 0 0 9] 

[f8Bj^i#jrfcb<fc'3£-r-5SIS] U*>U •/t-fDt> 

[0010] *»ma«±©iHHic**T&sftfc't>© 

X$>K>. »j«©S6»*fcttffi«S?»0«-W*ff3ilt* 

©^M1«IE£ff 3 C t * B Mit £. 
[0 0 1 1] 

[^S^fl?ft-TSfc«)CO#g] 

A -So 

[0 0 1 23 r&fc*>. fHMttft&amottBHffjpa 40 
t^nxi^iMii. fflE»&gefi©»£tSL&©g 

m*mm\.tcWimwmz£\z, m&.<Dmm<i>ikm>&ft*> 
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X, »EttaW*©*IM5J:tf/8;£B:ifc«SJlCtti"*-* 

[0013] *&, mt^-fv YmmsL^mt, m 

TME**H«*Kfctt**f«©^W4fc«£#». HE 
[0 0 14] 

[0 0 15] [SB 1 ©USSJgSg] #*ifi»IBTtt. gl£ 

[0 0 16] §g|H:>-»i-*fflt*.fcHMD©gi&K:JSi; 

[0 0 17] lifflHMD 2 0 0 tttr^x-X^-J 
S©fe©T»oT, I«^t5f-fXyK2 0 1 

ICDHMD 2 0 0 SStL&igf 
S*^Itf5*/72 0 2 5) 

SIB A. *&*pt5 2 0 2©«xsi©a5»sw-wr**» 

■fe>*2 0 3 (WAtfdTHyti'nt^) 
T^*. X, IMISI2 1 0«. tg3Hr>+r2 0 3 

^e-fe>-y-ta^*A^-r-2>-fe>-y-A^ : tvi-;i'2 1 

1. A/72 0 2*e%&tt#®AJgH<fc&A*rr«H 
fcAA'ES'a— ;P2 1 3, -fe^A* tya-Jl-2 1 1 
fr*>At)Ltztl*7 2 0 2©«^<D^tffi©^ffilCJ; 
Off*:** 7 2 0 2©8L6&Bf;:*-^T#*7 2 0 2 

w^cwftBsg^sifr-riffa ({"1^^4X40^ 

1P2 12, MtBMSS^ya-^2 1 2CJ:D* 
^$tlit«^©^B^^*«fc-rif«fC»^^TS*^ 

#e>mmz&mw#c>mm : &m&mm Ltzmm^^-r 

5B«M : Eya-;l'2 1 4 7^ *IT*3 9. 

x^k 2 0 1 \zm*kwm&mmT2>. z.<nm^. v$m 
mm\z&?x. •tyvmtivmmommizfecx'iivz 

•5. 

[0 0 18] fcj3, *jfeSS^aifC*5^Ttt, ®&®.w\t 

^mtvx^tbm^um^m^w : E:^^-JU2 1 21: 

*©8SS*fSH&# 

8ja&«©3lfK©f*»>SK*t LT1B*fffHC AS 

tt, «j6<MK:*^©«S&#*oTt>Hfc±T©<fcitr. 
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SHMD2 0 OlcS&lC&ftU ^©ttJ?j£8t;6&fi<i: 
[0 0 19] M. **JS»t&Ttt, ±fB<0SBS^e.. m. 

[0 0 2 0] HMD 2 0 0 SrK^fc***Jfi^S8lC 

[0021] m3\ZTKLrzwmmmmw3 1 o«. 02 
tcsbfciii#5aagg2 1 o 

1 5£ttillU a^lfi«iS»«» ; E5?3L-;P2 
1 2 ^«jftflr«*»a[J|CqE5?3.-JP 3 1 2 C^ILfcg 20 
m<Dffif&£ti.-oT^Z. d©«iE{iSSHE : &v 5 3.-;U2 1 
5tt, HHfcATJ^j.-;!^ 1 3frZXJlVtzWi&mm 
i:±>^Atl^^a.-)V2 1 1 fr£A#Lfc8L£tf>§£l£ 

-;i/3 1 2^tHlM5. SMI^^I^yo.-^ 
3 12H •fe>-9"A^ : &va.-;U2 1 lfrZAtlVtzJj 

*?2o 2 0)m.&<ngm£m<Djjmz&r)mzJj*7 2 

0 2©«jSCfiC«tm3Elt«» : E^3.-;U2 1 5^£>A*J 

mm (ffliE^w^^jnf j.-ff^jM$' ) ££j£-r-s. 

[0 0 2 2] &\Z, miEmmn : t^a.-JV2 l 5(;:*5tt 

**iiEtt«jMaa©ai*wjRaic'3v>Tttwr-&. 
[0023] *tiE<ai*s¥*aatt, s#i$fc«. wm±tz 

^mummva* > «mvr. ±>-y-mu\z 

mmmt. wm&w\z±-oT&&iz&mtsnzmm7> 

[0 0 2 4] #Hi£^!iT-«. 5>fy-i'©f>yi/ 
[0 0 2 5]-fl§:tC, 7->yU-h-7>>^>^tCj;oT 
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is. j3*? j £m&zt&y>#&t>*7mm%\z&vz>n- 

)l^\P\\Z\mfctZ>Z.L~Q>lE.V2>. 014 (a) 

lZ7nLtz7 u >7l'— MtT^ffl^T, 014 (b) fC 

Htttttt®l§l£€#*L&t>J8£ffl!iefTofc*$ 

£t£&£ttic? > k 1—9 z. t&m&fc^. 

— 014 (c) CinTJ:?^ H{fett8t0lBl1E&# 

mvrz&-v7->zfi'-hwm.T\z\Bim m<Dm^\t4 5 

0 «©0*e) fc^>7V-hiiHg!'r £«§&ffl* 

U &*©^>:/U-F®{gt#KJ$it$aa£fT 5C<!: 
[0 0 2 6] *3*l6»lBK*«f»Ttt, s£3H?>-tr2 0 3 

kjc-^t. *^^2 0 2<z>w.&<Dgmtfmffl2nT^ 

T. 014 (d) Ka«LfcJ:3lC. mm-t>-*)-2 0 3K 

«fcoTShafl$n-5*^7 2 0 2 wp-;u^fsjw0^ic 

go*(AT&g£iii|g! I \Z®m&MZ.tz%£&m& I ' 

U Z.<nmm I ' ±^*3UT5 i >7 p W-hili^T(Cj;-5 

[0 0 2 7] ***S^fC*3^T«. i<02M 

©^fc^t^Tt)^-fe>-^2 0 3 J: 
*IT*3 9, h97U— A*T-ro^atr*5^T^« 

lEfitiSff =6-^3.— 2 1 AlC&tt-S^ 
*tjE<i#»SttT^5,, LfeilbT. 014 (e) 

^*fLT©*-±fBC0[eie^a$:R : '5 uif, 7>h'V- 

9 aymmmm^rr oK&-x?3bz>9-yv wtRSM 

1 (014 (f) ) . mm&wzmfe-rzzEtf-zz 

•5. 

[0 0 2 8] SfoT. ^i^U- r-Vy^>yfC«fcS5 

[0 0 2 9] ^fC. ttiEffliSaL^Vi-^2 1 5©*ft: 
W^«fiK$r0 4fC^-r. 

[0030] mjEmmn^^^-^2 1 5«, ^iB-rs 

MBffefe^^jL— ;P4 0 3 mmt\z&rt2>w 
#1 ' t*/72 0 2«^# (roll') LIZ&-JI,* 

-z9-fv vwfo*$Lfa$z>9-fv vmm&^'Js. 
-;mo4, 9-yyhmmty L y^u-bmmtim 
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(^-r^MiEfT^jAM' ) KHfrL-cn^m^-rsfct 

(0 0 3 1] ^{3. **^liTffl^^.^©:(CO^T 
[0032] • i#S ( i = 1, 2, 3, , , ) ©5> 

• 7>Hv-fL, ©It^ffifitK^tt^&g (8E*D) £ io 

P , = (X, , Y, , Z , , 1) T 

• #*5©«5£©&g£ (X° , Y° , Z° ) 

^ (ro 1 1' , pitch 0 , y aw° ) 

• * / 7<D&tfe<DtiL&&&\Z&tf2>m&W&.& I 0 20 

• 7>HV-i/L, ©B&I 0 ± JWB«fc«*P 
, 0 = (x. 0 h, 0 . y, 0 h, 0 . h, 0 ) T 

*T, 

• t->:7V— FBfcClH'X (&£) SNXN 

• 5 L >7 P W— hB&©JSS©&B£x s T , xe T , y 
St. ye T ({B.U x s T =y s T =-N/2CD/J\gc 
gBSr^D&Tfcfii. xe T =ye T =xs T +N-1) 

• mm t CfiHTJWSftftMS I ' 

• «r*J t K*W-*-fe>lJ-t«k*iS»W-SI«* (roll 30 
1 , pitch', yaw') 

• '£&stmm (roll 1 .pitch', yaw') 

• mm i ■ ±(c*jtt-&5>h*-7-i'L 1 ©itgH^si&B 

*p, 1 = (x, ' h, ' , y, ' h, ' . h, ' ) T 

•mmi' ±r*iRK*msn<5 5>HT-^L I ©« 

&&g£p$, * = (x$. ' , y $, ' ) 
ffl«*ff-5»*t6:*^-yy HH<k*R. ' 40 

• 7> KV-^Oy^lfilW&aSiSH (gf/S) £±n 

• *—>fy hH&ro-ir-f X£N' XN" (fib, N* = 
N+ 2m, N" =N+ 2 n) 

• 9— fv hW&L<Z>Mte<»1$m&ii s R , xe R , ys 
r , ye R «HU, xs R =xs t -m, xe R =xe 
T +m, ys R = y s T -n, ye, =ye T +n) 

&mmm& a , 1 . k, d 

• #7>FV-*©tfttHaS* ( j , ' ., k, ' ) ©tt^E 50 
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tt* (J * . k* ) 

• mm t K:*^Tl|Cffl**l**^50iS»0*|jEK«f«[ 
Aroll, Apitch, Ayaw 

Ax, Ay, A z 

iE-T « fc» ©fctlEfT^J * A M * 

• £ft*T©»a-r«K:j*Hi*ftT«r»* assy t-iT 
mmznr^z) mmnFiz am 1 - 1 

•WJEffWAM' " 1 ^rttlEif^'J AM" KKirr*fc«> 
cDHlEEfrff A M ' ' 

•M' ^ttiEif^JAM' K:«toT*jEL.&*liE«0 : E'7* 
;Ufi-ff^J*M$' 

•M' ^MiEff^JAM' - 1 lC«fcoT«iEL*:*IE&© 

a. 

[0 0 3 3] <^>XU-hH&©ffr5£>£-f. 

ra^a-UTs* * 9 eK£ottBSftKR& lb& i . 
tawr*. muzmmio rhsk*«** 

^©aca-a^n^n© 7>H?-i? > x v 

[0 0 3 4] JfcK^xJUf ^.-ff^iJM 0 SimjT*. * 

^^©ttstig^e.^^jufa-fT^j^mm-rajsa 

-5. 

[0 0 3 5] Sfc. aiU*n&H«t«f©5>HV— 
(I1T1JL, ~L 4 ) CP, 0 &&.T<D#.\ZTWm-? 

[0 036] p, 0 =SM° P, 

, (01THT, ~T< T-^StlfegP»©H#) 

[0 0 3 7] r o 1 1 0 rt<0©i£te. B& I o 

(x, 0 , y, 0 ) ^M>cLtNXNWXffl^i 

r>^l/-bB«!T, lc^^T«B»©+'i>*ffiS 

(o, o) cgbt^titst, i©«aa«etT©± 

[0 0 3 8] T, ( j , k) = I 0 (x, 0 + j , y , 
0 +k) 

{SL» j=xs T ~xe T , k = ys T ~ye T o 
[0 0 3 9] roll" ^Ot&Hitll (x 

■ 0 , y, 0 ) £tp<fr£:LT. NXNOWS^-r 

oii° fc*^iHite$-e-fc^^^tttH-r'5<. t&fc 

j=xs T ~xe T , k = ys T ~ye T OSII 
T, (j,k)=I° (x,°+jcos(-roll 



( 7 ) 

11 

") -ks in (-roll 0 ), y.°+jsin 
(-roll°)+kcos (-roll 0 )) tt£2> 

[0 0 4 0] <s■^J^c^3^t•5> ;: E7 ^ ;^t•3.-fT5lJM , <r> 
»m>^j t ic*5tts-fe>-y-ai^ v&m (roi r , 

pitch', yaw')) i, 1i * ? <D®tfe?)GLW 
(X° , Y° , Z° ) dS^T. ^r^Hfi-fr^JM 

©iftH^tt^BS-r^»„ io 
[oo4i] <ffimmmnmw ■. ^^n^-fr^M' 

• z&iE-rztfisEnm am* owmumz^^xwiw-? 

[0 0 4 2] £rcn£T'(D&«T£Elcgffl£*XTV>£ 

eu m' * ft. zLvnawtfrnmoyms (t 

= 0<a*§£) . ffllEfr^JAM' " 1 tem&frm ii?2>. 

[0 0 4 3] M' ' = AM" " 1 M' 
#HZ&5>W-?mzp, ' £RT<Z>5£Ct£oT^ffl 20 
"f •£>. 

[004 4] p, ' =SM' ' P, 
ft. ccD^tett^w^rteTab-sfe*. f¥*fflteI&Hjra# 

[0 0 4 5] ifcK, F^-^SK^-y-y r-Bi{fc 

r, ' £f£firr-5. jMfcwtcte, Bar ^e.isiii^ic 
LtzN' xn" (vmrnmrnz-ro i r fc^iHife^-a- 30 

/t^SrtttHT'So -r/i^^. j=xs T ~xe T . k 
= ys T ~ye T Wg-iSSii Koi^T. £tT£>^J&£rr 
5. 

[0 0 4 6] R, ' ( j , k) = I ' (x.'+jco 
s (-roll 1 ) -ksin (-roll 1 ), y, 
' + j s in (-roi 1* ) +kcos (-rol 1 
1 ) ) 

yp-hia^T, <DV-y^>y£fr^, hiH# 
iK^tt-S^h-v-^OTfte (j. ' . k, « ) 40 

•5. 

[0 0 4 7] if^-yyhMR, ' ±<Dj^g (j, 
k) &tp.b£l,fcNXN<DmMmt$i£T>Zfl>- hH«t 
T, <h©3a<HKe (j. k) Srgffl-fS. S^SW^til 
BMAiffllffl^SSD (Sum o f Square 
d Di fference) te.Z\z£.r>T'frott. 

-©SIHSe (j. k) £3rC(0j&r/k (fcrc 
U j =-m~m, k = -n~n) Co^Tf U)L. 50 
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<H&e (j, k) &m*HZ-rz> j Rtfk£ (j, ' , k 
, ' ) 

[0 0 4 8] LT. &5>K^-^T*i6fc 

(j, ' , k, ' ) 7^£. (j ' . k' ) £HEHJ 

-r-s. ttrnmommi., s^yw-vrnzis. 

J&fc (j, ' . k, ' ) ©sp^lfi^x-C 7>tt£## 
-SdiTffP. fc*5. &7>KV-^«(C*J&fc (j, 

(j, ' , k, ' ) t>mi£<Dmm&r)b*:Z^y>\f? 

(j . ' , k, • ) t>mmwm&>±£t£z>7 > w-t? 
<Dmmm^.mxf<Dm^\z\t. t izsmzmiEm 
m»mm z n % ® o t t> «t v>. 

[0 0 4 9] ^-lt^ic. ^>Hv-^»^m^ic« 

[0 0 5 0] S-f. #*7C0s£#|<D*ltiEI6&HlA r o 1 
1, Apitch, A y a w££TF<E>«k 5 K LT#i6 
•5. 

[0 0 5 1] A r o 1 1 =0 
Api tch = arc tan (k l / f ) 
Ayaw =arctan ( J ' / f ) 

iESSfMAx, Ay, Aztt^T0i45. 
[0 0 5 2] *C JW±0^^ A r o 1 1 , A p i t c 
h, Ayaw, Rtf&gAx, Ay, AzlC«fcoT^«6 
e.n^^x^fi-rT^JtLT. *IEMffrf^JAM' ' 

SrSWr-5ffttl7jffita^»l©7jffiT*-5CDt?. 

[0 0 5 3] -£LT. CinS-ClC#e,tlfcttiErT?iJAM 

am* *t(T©s;(-tSoT#m-r-5. 

[0 0 5 4] AM' = AM* 1 AM' " 1 

<DW-m>mm t fc^tsttjE^co^x^e^-rT^JN^ 

[0 0 5 5] M$' = AM' M' 
•5. 

[0 0 5 6] R±, ftnbfc*%tt»8£l;:«l?«*fiEa 

[0 0 5 7] 0 5«±^O«IE«n : S©^'f ><Dmm<Dy 
[0 0 5 8] SfrVT'U- h!i#!£f£Err-5 (X^-y 

yssol) . ?>^ r i^- hm&*ftf$.-tz>M#wm 
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[0 0 5 9] ST. K£<Z>{5r«g#Hc@5££nfc#*5 

frzmmi 0 *x±-tz> (xf->ys6oi) . wzz. 

M° Uf7^S 6 0 2). *AiZ-£TV> i 

O^T (M^^^n^TCO^ > F^-^HOI^T) p 
, 0 £JJc#5 Uf7yS6 0 3, S 6 0 4) . WZJ- 

T©j> k»C*fbTHlifHI£#«>. T->yu-hHHfcT 
. (j, k) CftitS (^xy^S 6 0 675S 10 

S 6 0 8) . 

[0 0 6 0] ^±O0 6tC^L/c5!lSfCfieoT^>yU' 
-MH**£l«-r*i, 0 5KMoT. B&r ©as? 

*J©^#fcff? (Xf7^S 5 0 3) . HXt'^S5 

0 2, s 5 o 3<DQ} ! m<nmmzz\tx\zmiz.znz>ib<n-c 
[0061] ^{c-fe>-y-tb*tcSo*^T ; e7 ; ;Pt*3.-fT 

5>JM' <D»m^no (7T7^S 5 0 4) . -&bT*&IE 20 
fT^JAM 1 (Dnm&ftv Uf7^S 5 0 5) . ttiEfr 
AM' ©WmK:m*SJ*#W£«aS©7a— h 

[0 0 6 2] $"f. ttJEfT^JAM 1 " 1 TtfJl'fa- 

Uf7^S7 0 1) . *LTJfclc£T© i IC3V»T, 
»<^8l*.ftfc££T©7>h*T— JtOHTp, 1 £gtti 
•T-5 (Xf->^S 7 0 2, S 7 0 3) . fi, gtfjbfcp 

©*t&*v,t:-r-&. 30 

[0 0 6 3] 5fcK#5>HV— hH&R 
, 1 Uf77'S 7 0 7 0 6) . * 

Li^-y-y bmmR, • <t^>-/u- ms^t, ©v 

•y^>yS:ffU. & krtKSHHflEe (j, k) £ 
PffiTS Uf7yS 7 0 7, S 7 0 8) o ^vxmf&L 
Me (j, k) 35t«*ttt« (j, k) £ (j, ' , k 
, ' ) Uf77"S 7 0 9) . Sl±<D7>9-v7S 

7 0 7*^Xfy ys 7 0 9 STCjftli^T© i , W 

7"S710) . 40 
[0 0 6 4] fbt**fe (j, ' , k, « ) (DW-i^m 

£§H£b, ( j ' , k* ) SSWtS Uf77"S 7 1 
1) . *^5©^®^<75ttiEfiISr*«e> (X-r-y 

7'S712) . fcHEHfrfT^JAM* ' (Xf^ 
S 7 1 3) , Si^W^C«IEfT?'JAM , (X^y 

!/S 7 1 4) . 

[0 0 6 5] &,±<r>m7 izmhtdsimizw^xmiEnm 

AM 1 £»ffi-r£<»: ; @5l:IoT, gEffi bfctt oEfT^J 
AM' ^/BUT^-IHfi-fT^M' SrfcilE-rS Uf 

5 0 6) . 50 
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[0 0 6 6] ^bTffiE&W^xJl/t'i-fi^JMS' & 
ffl</>TCG£ffiH. SStl. Uf7^S 5 0 7) . 
[0 0 6 7] ^±©Itt^tC«k0> *mfi«ffi©Hlfe«iS 

^©^tfSIKM^ttlE bT{4B-f*l©&<^M R 

[0068] [as 2 <D^m^m] m 1 ©^js^sg-m. 

ffllE^lSSr*-;!'-^ (IS BUI/- 7) ©*Tfrt>TH 
071/- AU- h&fttt&ZZ.ttfT'Zte.l'K $>2>^ 

». mm<D7 v-kv- h^mu-t^fzibizm^mi 
mmti*><o (tf-®s©'>&^*>©) \z?zt. «ie©* 

[0 0 6 9] *£T^**li^Mmi»H;i'- 

[o o 7 o] <&H;i/- te0 5. 6(c^b 
s 5 o 5C«frvr. &i£©MiE§[g:;i/-:/J:0ji{f £ti 

&S$T©fttIEfT5>JAM" SiTCni£AM' it4»i 
[0 0 7 1] <IjESS£^-y>i8 KSflEiMtUI/-:/ 

©Ii©7n- ^v— h<£^-r. SB;!'— 

^IJM' £A2>-r& (Xf'^S 8 0 1). -eLTSl© 

HJS^-eiJiBJLfex^^ys 5 o sfcisttafflstfa 
2) . ^-bTgmbfc^tiEfT^JAM• tawHyca 
Wpid^ss-e^ff-r^ Ur7ys8 0 4) . 

[0 0 7 2] #*«#»Ttt»B;P-:/£1«iEBJIW- 

-^©H&aaagfi <«*.«> ©*-?sifTb 

T^fc**, £*U;:fg££*l-5 ; &©T«&<, 5fe*©JP- 
:/© g £ * * <1 ^ © a > fcT i - ^ T? ^1 fT b T *> A 
fit, **©3>tf3.-^^T®«W^^«lil'bT 
43$. ^>*©n>t!aL-^P4T"^^©®ai^m*ji§m 

^^ttjt-=>ffia^«'>^<7i-5©T, «t offla^cMa 

[0073] [» 3 ommmmi & 2 (DmmmmT'it^ 
TfrVx.-ftmomjEomwizis^T. mnr^miEfT 

fB*i^^T^-l)©T. ffliEff^J^Tb^Jltt©^^- 
A (^f^ijt) lCjg^^«iE1fffi^^bTt^t«*Ai^ 

[0 0 7 4] -?"^T-*:SliS0^T*«, M2©SIM^tC 
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*3tt-5X^>>yS 5 0 5JC*3^T. JtlEtSgUU-^ £ 

ff^JAM' &wm-?z, 

[0 0 7 5] ^fgijs {3*5tiT#en-5ttiEfT^JA 

w* Rtftf-y^fatDlfiEfaAp i tch' Srgfflt- 

i \z&^T'bmmu<&m&&z.tsi^. mm t icim** 

^7^^0DMiEilT*-5A y aw' RtfA p i t c h' 10 

[0 0 7 6] Ayaw' =Ayaw" + (Ayaw* - 
Ayaw* ' 1 ) XAs t/AsApi tch' =Ap 

i tch' + (A pi tch* -Api tch' " 1 ) 
X A s t /A s 

A s t itmMsfrZRrM t £T©i(§iailfP4> A 

s t*i$*i s - 1 frzmm s %.-coi&mmr$&mio? : b<o 

[0 0 7 7] ^-LT^etlfelilEfitAy aw' Rtf A p 
itch' £ffl(^T, fctjErr^JAM' 20 

CltlCtoT. SUtCD^U—A (P#Jt) lCjgtg&*iIE 

[0 0 7 8] Hit. **Mi»IBTfe±fB©Sk:wUfc«t'5 

\z i jfcowjB^ancioTHiEiao^jf *frt>T^a 

[0 0 7 9] [M 4 WSHJS^ffi] **Sfi^«T«. 1 

[0080] s-r. *mffiMi&-zm^z>&$tik<Doiz>, 30 

[0081] • mm t fc^w-s-fe^-y-ttiAfc*^^^ 
7*;nfa-ff5>icoiaeric» R ' 

$, 1 = (x$, ' , y$, * ) 
•5>Hv-i7L, « r@Hfci' ±^©a»jftj 
5as**K:iJ**Stt«p c , ' 

• 7>KV-i7L, 3^S*»6n*. •t^tfa.— fr5>J 40 
C0*iEIEfrfT^J (^fi:^rS]©[Hiefi£») AR, ' ' 

•7>HY- ^L, ^e*»e.n5, y aw^[6]OliiE 
JSSrtt Ayaw, ' 

HStM Ayaw' 

• ^^ei-fT^JWttiEfT^J (#ft27(6)W!5]tefi£#) 
AR' 

• cnsToiaaTiEtcffffi^nT^sffiiEfT^JAR 
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ftm<D^tfctfi.ft R ' ' 

• fcHEfT^JAR' - 1 tCfcoTSiESnfe^^Hfi- 

m* * 

• ttEfT^JAR' - 1 £*tIEfr5>JAR' IcERf**© 
SiEHfrfT^J 0&&#fiO[5iefi£#) AR' ' 

OI/iTl^^teCDMaro7P— H4^t0 9, 10 

[0082] m9\$*&ffiMm\z&tf2>*'( xDrnmo 

7P-ft-htfe5. 7,t-V~?S 9 0 Ifr<b7>7-v7 

s 9 0 3 iT©jai«i 1 <n$kmwmz&rtz>-x7-v 7 

S 5 0 l^X^y^S 5 0 3^T<7)MSi:llU-Cife-5 

[0 0 8 3] iMc. ^^fi-fT^JWHIft^R 
1 i, ¥ffS»)fiK^T' ££HttJ-rs Ut7^S9 0 

4) . ^w^«iHitefi£^R' -t:>itm* (-tr>-y- 

*^#fc*^7©sS») (roll', pitch', 
yaw' ) izm-j^T'jktilOjjm-V&ibZ. —Jj. W-fr 

[0 0 8 4] ^LT&l'ttlErT^JAR' £#iD-5 ttr 

7^5905) . itiEfT^jAR* z&tbzm&wmm 

©7U-ft- r-£H 1 0 C^U 

[0 0 8 5] £tt*T©ffl3TgEtc3¥ttiS*lT^ 
SfcfErT^JAR' " 1 Tff^JR' £ £TF <£>«}; 3 KLT« 
IEU fr^JR' 1 

[0 0 8 6] R' ' =R' AR' " ' 

5(CbT*«)-5 (Xx-y^S 10 0 1) . 
[0 0 8 7] M' ' =R' ' T' 
X^y^S 1 0 0 2*^Xf2/^S 10 10 
tt-^n-etlX^-yT'S 7 0 2*eXf7^S7 10ST 

[0 0 8 8] #HZ. ( j , ' , k , • ) 

TWm I ' ±CD&:/> FV-^Oftfip $, ' = (x$ 

, • . y $, • ) £»m-r*> uf^ys 1012). 

[0089] x$, ' =x, ' + ji ' cos (-ro 
11') - k,' sin (-roll') 
y$. '=y, ' + j. ' sin (-roll') +k 
,' cos (-roll') 

©*^7ffis^ic*3it^^sp c • &nm-?z> Uf 

y^S 10 13) . 
[0 0 9 0] 

PC ' = (x$, ' . y$, ' . - f . 1) T 
Z<Dt&. a£X>r-*)>?/t7*-?t?2>ii. pc 
, ' • a = R' ' AR, ' ' T* P, ^fiKSi-r^. Z\<D 
SSIKutT. Ayaw, ' SrgajfS. 
ETFK^T. fc'fcU JWT-C. Inv (M) \Zft&M(D 
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i£fir?«J£*ir. 
[0091] P$, ' = (X$, ' , Y$, ' , Z $, 
' , l) T =Inv (R") pc, ' 
P* i = (X' i , V i . Z' i , 1) =T l P, 
t&<£. P$, 1 = A R i * 1 P* , ZattlZcD 
T*. 

X $ i ' = {cos (Ayaw, ' ) X' , - sin 
(A y aw, ' ) Z ' , } /a 

Z$, ' = {sin (Ayaw, ') X' , +cos 
(Ayaw, ' ) Z' , I /a 

Ayaw, ' =arctan { (Z$, ' - X' , -X 
$, ' • Z* , ) / (X$, ' • X' , +Z$, ' • 
Z* , ) } 

ttSiZ (7f7^S 10 14). uOXf7^S 1 0 1 

4CDjaa<&-r^T<D i , -t^t©5>ht— 

?\Zttl,T$i!sb2, 10 15). f bT*6 

fct^TOAyaw, 1 CO^fit A y a w' £;fca65 
(Xr'y^S 10 16) . 

[0 0 9 2] ^LT, #»fc*|jEje*rttAy aw' 
^TttlEJE^ffT^JAR' ' £##3 (.XrvZfS 1 0 1 
7) . mmm^Qi^^S. (~ ~TttA yaw' ) T7J 

fi^isj c me £ -a- * =e tMu f a -ff ?>J £3£ m-r a « 
RniitRti. JKomjEwmnmii 

R ' ' Srffl^T. *^^)*^^«iEff?"JAR , £WT©J: 
5(-LTJ£«>-£> (Xt^j/^S 10 18). 
[0 0 9 3] AR 1 = A R ' " 1 AR' ' 

tH-rSt. 0 9lCMoT. gtHL*:*IEfT?>JAR' £)S 
^T^x;H£a-fT?>JM$' £Stii-f3 (XT7^S9 

0 6) . sm««T©s;icseoTff -5. 

[0 0 9 4] M$' =R' AR' T* 
7) . 

[0095] v%,<b<jyaMMm mmm4<D^mmm 

Ttt. «j&©ffi««H»l£U CSffl. £«) ©a- 
©*tjE£fTO/t. Mj^Lfc^tC. IiM^*ST<D 

CTLS5. ioT**«S»ttT?tt«jiSitt«©*liESff 

ttszw^isi (*ff**iaj. aMkBicsift&:fri*i> ©# 

HATz te^lc0T-*-5t>©<i:<K5rf-5. Sit. 

1 jfit© 5 > H V - i7 otftffl \z «fc 0 {4g ©if IE £fT 5 d i: 
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[0096] • mm t »c*3tt*-b>-y-m^i-so*^fc^r 

• mm t fci3tt-5*^5wiE^wfi:sicSo*^fc ; &T r ;i' 

T' • ^5^b'i-fr^J©»iEfT^J (tt^ffiS* 
lC*5tt^JFff^»)^) AT' 

ttiEfT^J (1&lfJ^S^t:*3^^¥fT^K)fi£») AT, 

t 

10 • dttSTCDjfflSTKtwgfcb^tlT^-SiilEfT^J AT 
' " 1 (PBfc^-^-Cttlti&fT^J) 

• JitlEfT^JAT' " 1 iCioTlfiE^nfc^xJUfa- 

•MiE^JAT' " 1 CioTliiESn&tTMia- 
ffW M* ' 

a ¥ff A T c ' 

&&*) ©«jEM£H1ATx, ' 
20 •7>FV— i?L, *^*«6etl-5, yttTjfa (#*^ 
mm*) ©MiEMSTfitATy, ' 

• :£T©5> K-7-:?#>£jJ<8&5ttS, x|J|Sl 
7&g#) ©«IEH»rffl A T x ' 

7«») ©«IE3g£rtt ATy' 

HTH^ftOfflI©7n-ft-h^til 1, 12 

[0097] s i i \$*-&Mmmz*5i-t2>*'i><D&m 

30 £07P-ft-hT*5. Xf-y^S110 1*^Xf 

7 7"si i o 4*T©iaa«. ssuwms^aifc&w-* 

T.t-^T'S 9 0 l^e,Xr'y7'S 9 0 4 fCfctt-S&fl&g 

[0 0 9 8] #.\Z. ttiEfT^JAT' £##-5 (XfyT" 
S 1 1 0 5) . SUEfr^JAT' £#4&£:fl^£i<)&$aH© 

[0099] sr. ^tiSTwmsT-Mic^m^nr^ 

a«iEfT^JAT' - 1 X'ftWT 1 £f$IEU fT^JT * ' 

40 2 0 1). 

[0 10 0] T" ' =AT' " 1 T* 
M' ' =R' T' ' 

^©T.-r^yS 1 2 0 2^6Xf7yS 12 11 STf© 
&XL9M:. ^4©^JS^l-*5ttax^-y7°S 10 0 2 
*>exf7ys 10 1 2 S-CW^SSr^CT^afcJe) 

[0 10 1] WzXTy-JS 1 2 1 2X11 7>h"7- 
?L, iCBI-T^ttiEMfffitATx, ' , ATy, ' SI 

m-ra. 

50 [0 10 2] 
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ATxi 1 = f • Z c i ' (x $, ' -x, ' ) 
A T y i ' = f • Z c , ' (y $, ' -y, ' ) 

zMmV, M* ' P. <D&3f&fttf*(Dm£tz2>. 
[0 10 3] ^±©ffliElgSrffiATx, ' , ATy, ' 

2tc#> (X^>>^S 12 13) . ^C**6fcT^-T©«iE 
MfHSATx, ' . ATy, ' (DSpSHtATx' . AT 
y ' Ury^S 12 14) „ •€• bT, 

MlEMfffitroJFJ^fllATx' .ATy' SfliHT. x^ 
|S]CATx' , y^ftKATy* ©3pfr»ft*«**ir 
!6-r*fIEJE*rfT5»JATc ' £StH-f-5 «f^S12 

is). «*s£g*o s ffif»»«tt?£*xstffaie 

S 1 2 1 6) . 
[0 10 4] 

AT' = Inv (R' ) A T c ' R' AT' " 1 

£i±ffli i 2^t^Lfc^^l3s^c^i£oT1SiEff^JAT , 

m-rst. 01 ltgot, ^tiibfcMiEfT^JAT' £ 
ffl^T^-JVhfa.— fr?IJM$' (X^y^S 

110 6). *ffitt.KT©5SK:fieoTfT3. 

[0 10 5] M$' =R' AT* T* 
0 7) „ 



Ary 

AT* 



20 



/l 


0 


fit) 


0 


1 




1 


0 




0 


1 








j 



[0106] [^6 ammi&mi w. 5 ©susjgss-m a 

[0 10 7] *3fe«S»IBK*Wa»iEa«©7n— 
-h«S*WfC«m5CDHJfi^liT^bfe01 1, 12 
<h|B}i;-r&&#> XrvZfS 12 14. S 1 2 1 5\Z& 

iEfflST*XT--v^S 12 14, S 1 2 1 5 lets 

[0 10 8] x. y, ztti^falCiJtt***^®^© 
ffilEMfftt^ATx' . ATy' . A T z ' t*3<i. 

[0109] ATx' +x$i ' -f-ATz'=f- 
Z c , ' (x $ ■ ' -x , ' ) 

ATy' +y$, ' • f • AT z ' = f - Zc, 1 (y 
20 $, 1 -y, ') 

iot, &1&<D 7 >Y^- 2 VAT <nm±l35m^ 

£fcT. cn£#K £<hT'. *»©*jES*rttAT 
x' , ATy' , A T z ' S^mTS Uf7 7*S 1 2 
1 4) „ 
[0 110] 

mil 



f fZc[(x%[ 


-*{) 


fZc[{y%[ 


-*') 


fZc' 2 (x$' 2 




fZc' 2 (y$' 2 





[0 111] ^LTfEttlLfcATx' . ATy' . AT 
z* Sffl^T, MiEMSTff^jATc' ^^SlW^ffi-r* 
«65 (Xf-^7S 12 15). fbTXT7^S 121 
6T«*«6rcMfffT^JATc' SfflHT»5 a>*JfijMB 
(hlaJtRlC LTtUEff^J A T' £#«>3„ 40 

[0112] mKDmmmm mmm6(D^mmm 
■oft. ^mmmT\,tt(Dm^<r)miE^noo s#w& 
lE&ff?. isfrLz\n\zm%.2tiz>>b<o-c\tti.<> 

ft©*iIE (t>b<tt^WiJSco)l@^T : foAli) £-$£|h1$: 



[0 113] C£T**«#tre«Tffl^*t8!J£K:tn> 
[0 114] • 5aaro+Ffl©|5g(cf#e.tifcffiiEfT?iJlc 

• &w<D*mfkmzn<intzniEftm\z£.'oTmjEi£ 
[o 1 1 5] Ei 3tc**jfi^fc*tt*^'f ><Dmm 

«, m4<7)mS^^COE9tC^L-fc7D-^V-h^ti 
jEff^JAT' $^W-r-5iaa {X^yy°S l 3 0 6) £ 

AR' £gWr-5$!Ui (Xry^S 1 3 0 5) C43tt-5 
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at* zwrntzmm uf^^s 1 3 0 6) . stiEfir 
5>jar' znm-rzmw cx^-y^s 1305) ton 

•5. 

[0 116] XrvZfS 1 3 0 5(C*3tt-5ffiIfr5"JAR 

\tm4<r>mmmm<Dm 1 0 issH-T*«*». #s£fls 

7,J-vZfS 1 0 0 lfCiSUT, ff^JR' * & 
tfM' ' ©^tbicjtraAfT^JT' 1 ©^ctB^ff^. 

{0 117] R' 1 =R' AR* " ' 10 
T* ' = AT' " 1 T* 
M' ' =R* ' T" ' 

■t-L-T, m&<r>wm m^ts 1 0 1 4) k^t. m 

[0 1 18] — 3Er. Xv-VfS 1 3 0 6fC*5ttS«IEfT 
MAT' SHjET**#W3St«ia07n— ? + — htta 

5 (Dnmj&mom 1 2 

1 3 0 ST'XtbtzffiiEftmAR' ^fflUTfr^JR 1 20 
£ttIEU fT^JR" 1 iM" ' &£TF0>3lCftoT:&i£> 
S. 

[0119] R" ' = R ' AR 1 

M" ' =R" ' T* 1 

X. *&2Rjgffilc:J3tt«£L!IttH 1 2 ©7U-ft~ h 
IdfeUT. XJ-y-fS 12 1 2TATX, ' . ATy, 

[0 12 0] 

ATxi ' = f • Z c i ' (x $ , ' -x , ' ) 

ATy , ' = f • Z c . ' (y$, ' -y, ' ) 30 

z&gT% M" 1 P, <Dm3l&ft&^<DmttSL2>. 

[0121] **ss^Si(c*3^5.^s«iai 2<D7 

D— MC43UT. 1 2 1 6 T*t iEfT^J 

at- fc*uj-r*a«, j^T»iE:icfi£oT*ffi-r-5. 

[0 12 2] 

AT' = Inv (R" 1 ) A T c ' R" ' AT* " 1 
-eL."^-^^^^^ *t»TTSt. H 1 3 KiR 
Vfcya— J-*— h\zMK>. Xr77"S 1 3 0 7l;i5H 
T^ETMHf a.-ff^JM$' S:WT<7)«fc^lCbTgm-r 40 

[0123] M$' =R' AR' AT' T 1 
1f.1t. ±Si©ttiEff?iJAR' . AT* &$.tt>2>mm (X 
7-y-fS 1305. S130 6) £±j$«ii Of^ES 

[0124] i^8<ommmm^ mm^7<Dmmmm 

jt^Ji^bTfe-fc^L. ^JW&Bgf&K^tfSilHfcl 0 50 
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[0 12 5] CIZIT. ^Xts$>Z>WZm®L9£M\Z&-DT 

m&m.m (x, 0 , y, 0 ) K»**nTt»*Hik«p« 

0 = (x, 0 , y, 0 , f, 1) flfcfWS 
gtt. ffl»ttll£»KfcttS^;irlf;i.-fraiM 0 <z>2* 
fT*l*Jflfr»T, P , = I n v (MM Pc, 0 t&m-? 

<d * s jgjtv-r -5 c t an? # -a . 

[0 12 6] fcifc'U 5>HV-^firBW*ff^73|6]© 

[0127] [*»«i] ±mmmmmz^x\t. m 
sw-arr* ^-rn©fflj^cffl us c: i t, oimT&z c t 

[0 12 8] ±8B3te»»»C*S^Ttt. bf 

SfflMRyXrAT-$oTfc, *^BJcDBi^agBlC 
HMDI^S^-fe^tJ-^S^-T-SttfelC, ff-W 
(XteftBsSI*) K«7J*«»T&£<fc3&<£Bf::@5££ 

wt&mmm) sstm-rs. ait, 
w<nmitMw\$&ffltt&y)mzmi]c.2ft2>h<D-ciztz 

[0 12 9] [^^J3] ±G*JKflMC*t>Ttt. T" 

[0 13 0] [JB»«4] ±aa*tt»«K:*lr»Ttt, * 
— y-^ hH^!^fie^:v?3.-^4 0 4(Ct3l/iT. 7>HV 
-^«)?-Zl!lfiB«3fi^«^W*^^-y>> hli^iLT 
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W^Slfi:B**«6-e ©ifi# K *> ^T^f&JS^ ft ft o T *> 
Al^U BHfcI* ©B«£ttKl»LT*fJS;«*ftfToT 

[0131] [^««SJ5] ±E*K«HBK:*S«r>TH:. % 
»3U;MfcB*»©iHWftB«4:LT. fOfatl,Tf 
> !/ U- h V y ^ > ^ \Z i S 5 > h* V - ? & m ft ffl ^ 

Kv-*©teBftttta-r*J8ifc-e»ntf. g^xitfit 

[0132] m<o$zvmm] xmrnommz. mmi, 
fc*«»»o««6ft*s-r*y 7 h^z7©^p^A 

3-h*SaB»UfcB««t# (*fcttE»«W) ft. ->x 

wn>tfa.-^ (^fcttcpu^MPu) j^eifttt^K:«jn$ 
nfc y o y 5 a 3 - k ft s^m b nfT-r s c t \z & o t 

s «*m a n?t y d y 5 a n - h g #«*WJ6 u fc 
mffij&m<Dmmzmm?z>z\t\zti.r). *<D-7utr=ru 

3- H ft E« UfcfB1g:iSE*«*%Hj ftftfiST £ c <h (eft 
ftHfT-r-5Cl<>:^«t 0. W^Lfc*J6^©ttltl***li 

X^A(OS)?S<i:^^©«!ia©-gBSfc«^geftfT^, 
[0 13 3] Ete^tta^^ttiSnfc^D^ 

3*^U -?-CD^0^5A3-F©^ 
^aCPUfe<i:^^<?5«aa©-g|5Sfe«^:gCftfTV^ * 
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[0 13 4] *38Wft±EIBB«l*lCBffl-ra«^. * 
©EtttSSEttlCte, 5fetC|5i^Lfc (0 5 7550 1 3 ©5*. 

P y ^ A n - H £ tl ^ d <t C ts. -5 . 

[0 13 5] 

[5!^©^m] &,±<DWimiZ^r, s *5gBJC«toT, §5 

io «aicfii-3Tfei;**tt5Err«ioaia«S6o*tjEftfT'5ii 

t**T€T. {SB-rtlW^^MRft^T^^i^T^ 
a. 

[Ei] isoWiS^i 0 ft^-TETab-5. 

[@2] ft&ommmmmwoffi&z*? atss. 

[0 3] aXtt»SMc«tt«BttfiagB 
©tt^ft^-rs-es-s. 

[04] ffija&BgfcttiEffiiai?*^-;^ 1 5©i 

20 [0 5] **W©«l©*Ml»JBK*»t*^-f >©fflS 

[0 6] x>:/w-FHBftffr***«©j*#Wfciaa 

©7 □ — — hT&-5„ 
[0 7] *tjEfT5>JAM' (D&m\Z&ttZ>&&mt£®m<D 

[0 8] **WO«2©*M»IBfc4J»t**|jE*»;P- 

[0 9] *BH©*4©*M#«K:*w«*^>©ffl« 

®7U-ff- FT* -5, 
30 [010] ffiiEfir^JAR' ft#J&SJMM«JfcftlH©7n 

[011] ^m<Dm5<Dmmmmzm-f^^^>nm 

[012] ttJEfT^JAT' ft*J6*A#Wa:«ia07n 

[013] **«o*7©*jS»IBK:*W*^-f 
l©70-ft- hTr&&. 

[014] *^ajtct5ttS5 : ->yu~h-7u/5 1 >y(0S 
*ISSftiftHJ-ra0-ca&-5. 
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